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INTRODUCTION 

PID (proportional, integral, derivative) compensation is one of the most common forms of ciosed-loop 
control. Control of closed-loop systems that require compensation is a growing area of application for 
embedded microprocessors. In these systems, analog signals must be converted into discrete digital 
samples before compensation or filtering can take place. Loop performance dictates the sampling rate, 
and calculations must be complete before the next sample time begins. These loop-related constraints 
and the Nyquist frequency requirement place an upper bound on digital control of closed systems with 
feedback error. If the controlled system has a resonance or other behavior with a time constant shorter 
than the sample and calculation time, chaos is the most likely outcome. Despite these limitations, 
increases in microprocessor clock rates and the addition of on-chip control-oriented hardware are 
expanding the number of medium performance control applications handled by 8-bit machines. While an 
expensive DSP-class processor is the correct choice for the most demanding applications, several 
members of the M68HC1 1 family have the speed and resources to control multiple PWM channels. 

This note provides two working examples of PID control-loop software. The first example, written primarily 
in C, shows a PID algorithm in a straightforward way using floating-point math. Key features of the C 
environment are covered for readers who are more used to assembly language. The second example 
implements a PID algorithm in assembly language. It uses the MC68HC1 1 N4 on-chip math coprocessor to 
speed up arithmetic operations. 

Both examples are complete and ready to run on a Motorola M68HC1 1 EVS evaluation board. External 
interfacing is identical for both examples — an 8-bit analog to digital converter is used for input, and an 
8-bit PWIVI waveform is output. Because the code in both examples carries more than 16 bits of precision, 
and because both processors support 16-bit PWM, only minor changes are needed to increase precision. 
Power amplifiers, sensors, and other interface circuitry must be supplied in order to experiment with real- 
world systems — a simple RC circuit is used for software checkout. 

C and assembly language source code and loadable object code can be obtained by calling the Motorola 
FREEWARE Bulletin Board Sen/ice at (512) 891-3733. The FREEWARE BBS operates 24 hours a day, 7 
days a week, except for brief periods when it is down for maintenance. The BBS serial format is 300-2400 
BAUD, 8 data bits, 1 stop bit, and no parity. 
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THE MICROCONTROLLERS 

The MC68HC11K4 and MC68HC-J1N4 are 16-MHz devices with nonmultiplexed external address and 
data buses. Each has 24 Kbytes of on-chip ROM or EPROM. Both devices have multiple PWM channels 
with programmable period, duty cycle, polarity, and clock source, in both, two 8-bit channels can be 
concatenated to generate a 16-bit PWM output. The MC68HC11N4 also has two additional 12-bit PWM 
channels and two digital to analog converter channels with 8-bit resolution. 

The MC68HC11N4 is particularly well-suited to PID computation because it has an on-chip math 
coprocessor that performs 16- and 32-bit multiplication and division, fractional division, and muttiply-and- 
accumulate operations. All operations are done by means of memory-mapped registers, thus preserving 
the standard M68HC1 1 family instruction set. Multiplication and fractional division are complete in a 
maximum of 5 micnsseconds while integer division requires a maximum of 8.75 microseconds. 



PID ALGORITHM 

The general flow of a controlled system with PID compensation is shown in Figure 1. References 2 and 3 
provide a complete analysis of digital PID control, but it is worthwhile here to informally review the 
derivation of the discrete forms of each tenm and how they function. 
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Figure 1. PID Flow Diagram 



There is a desired setpoint in our process (Gd) and a measurement of the actual value G{t) in time. Error is: 



e(t) = Gci-G(t) 



MOTOROLA 

2 



AN1215/D 



Output correction x(t) for the PID controller is: 



x(t) = KPe(t) + Klje(t) dt + KD^|P Jt = T 



where KP, Kl, and KD are constants. 
Now, rewriting the integral: 

t 

x(t) = KPe(t) + Kl j [Gd-G(t)]dt + KD^^ |t = T 

To introduce discrete time, let t = kT where k = 1,2,. ..,n and T = the sampling and control update period. 
Now, to = (k - 1 )T. The integral evaluated from (k - 1 )T to kT can be approximated using the trapezoidal 
integration aile. The derivative of the error term is simply the rate of change of enror, but this can be noisy 
over one period. Using a four-point central-weighted average for the difference term is a practical way to 
deal with this on a microprocessor. 

The form which can be executed directly on the microprocessor is: 

x(t) = KPe(t)-^KlfGdt--(G{Kt)+G[(k-1)T])]-H^((e(kT)-e(k-3)+3(e(k-1)-e(k-2))) 

' 6T 



V 



This term is added to the current output and put into the PWM control register at the beginning of the next 
calculation cycle. Substituting the microcode labels for constants and variables into EQ. 4 and using C 
language operator notation gives: 

NEWDTY = KP * (ERRX) + Kl • PERDT • (CMNDX - (ADRCX + ADRCXM1 ) / 2) + (KD / (6 ♦ PERD'O) • 
{(ERRX - ERRM3X) + 3 * (ERRMIX - ERRM2X)) + OLDDPf 

The function of the proportional term is clear, but the derivative and integral terms may need a brief 
explanation. When a system with only proportional control is off the specified setpoint, the controller will 
increase the control voltage until the error signal is zero, and the system thus returns to the setpoint with 
more applied voltage than is required for maintaining equilibrium. This causes overshoot and, as the 
process continues, under-damped ringing. The derivative term contributes proportionally to the error rate 
of change, but with the opposite sign of the proportional term. If the proper constants are chosen, critical 
damping can be achieved. The role of the integral term is to eliminate steady state error. A system that 
has a steady state error when tracking a ramping input function can use an integral term to integrate the 
error over time and compensate for it. 
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C LANGUAGE IMPLEMENTATION 

This version of the PID control routine illustrates use of high-level language for control applications. High- 
level language offers many conveniences not available in assembly language. Here are a few instances: 

Memory-mapped registers can be defined in a single file, which can be included in any function. 

Since C is a strongly-typed language, the compiler can identify data-type mismatches, such as writing 
a 16-bit integer to an 8-bit port. 

Most C compilers for the M68HC1 1 family allow direct vectoring to interrupt service routines. Interrupt 
functions are usually defined for a special memory segment with a base address and a function name: 

interrupt [INTVEC_START + 26] void RTi_intenTjpt(void); 

When an interrupt service routine is written it can be declared as an interrupt function instead of a 
normal subroutine: 

interrupt void RTIJnterrupt(void) 

The function is compiled with a terminating RTI instruction, eliminating the need for a patch between 
hardware interrupts and C subroutines. The void statements indicate that no arguments are being 
passed to or from the interaipt routine. 

One of the most attractive features of contemporary C compilers is the ability to add floating point math 
with an "include math.h" statement. Even when the final application cant afford the time or code 
space for floating point calculations, use of floating point math during debugging provides an 
excellent means of testing new algorithms. 

Now to examine the control routine itself (refer to Appendix A for a complete C listing). After necessary 
files are included and floating point variables are declared, a prototype is given to define an assembly 
language function that is used later. 

The main program initializes constants and variables, sets up the required on-chip peripherals, and waits 
for interrupts to occur. The M68HC1 1 real-time interrupt (RTI) is used to establish a precise time base for 
performing PID compensation. The period (T or PERDT) is determined by the RTI rate. In these 
examples, the period is 16.383 milliseconds, but this value is arbitrary — in real applications, the 
performance of the controlling microprocessor and the requirements of the controlled system determine 
the period. 

The RTIJnterrupt function is a workhorse. It does PID loop PWM duty cycle calculations, performs I/O 
using the DOlO assembly language function, and checks the results against the usable PWM output 
range of $00 to $FF. If a floating-point result is out of range, the closest limit is substituted. This 
"saturation arithmetic" prevents out-of-range results from causing sign-reversals in the PWM output. 

Details of error-checking and the DOlO subroutine are best understood by looking at the format of the 
floating-point variables. The four byte format is: 

SEEEEEEE EMMMMMMM MMMMMMMM MMMMMMMM 

S represents a sign bit, E represents an a-bit exponent biased by 127, and M represents a 23-bit fractional 
mantissa (significand) with an implicit leading 1. The I/O range of $00 to SFF is scaled into the eight most 
significant bits of a floating-point variable, giving a floating-point range of 1.0 ($3F800000) to 
1.998046875 ($3FFF8000). The following expression is used to evaluate a floating-point number: 

F = [(-1)S] [2(E-l27)][i.M] 

When the RTIJnterrupt function returns control to the C routine, the last task the routine must perform is 
preparation for the next period. A two-element pipeline of the A/D reading and a four-element error 
pipeline are updated. Finally the "old" duty cycle value is copied into OLDDTY. 
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MC68HC11N4 MATH COPROCESSOR 



The assembly PID routine uses the MC68HC11 N4 math coprocessor, which is commonly referred to as an 
arithmetic logic unit, or ALU. A brief description of the coprocessor will aid in understanding how the 
routine functions. 



The ALU performs 32/16-bit division, 16/16 multiplication, multiply-and-accumulate operations, and 
1 6/1 6-bit fractional division without CPU intervention. The coprocessor has one control register, one 
status register, and three data registers. The 8-bit ALU control register (ALUC) controls ALU operation. 
The 8-bit ALU status register (ALUF) signals when an operation is complete and indicates the status of the 
completed operation. Data register A (AREG) can hold either a 16-bit multiplicand or a 16-bit divisor. Data 
register B (BREG) can hold either a 16-bit multiplier or a 16-bit remainder after division. Data register C 
(CREG), which is treated as two 16-bit registers (CREG High and CREG Low), can hold a 32-bit product or 
accumulated product after multiplication, or it can hold a 32-bit numerator before division and a 32-t)it 
quotient after division. There is an implied fixed radix point to the right of bits AREGO, BREGO, and 
CREGO. 



Figure 2 shows coprocessor registers. Arrows indicate the most convenient order of writing the registers. 
A description of ALUC and ALUF bit functions follows. Figure 3 shows typical data register formats. Table 
1 shows numeric ranges of ALU registers. Table 2 shows signed expression of numbers. Table 3 shows 
fractional numeric representation. 



ALU REGISTERS 



■(CREG HIGH)-- 

■-CREG 

•(CREG LOW)- - 



ALUC 



AREG 



BREG 



32 BITS 



ALUF 



8 BITS 



16 BITS 



16 BITS 



8 BITS 



MAC 



MUL 
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FDIV 



V START 
MULTIPLY 



START 
DIVISION 



START 
FDIV 



copnacessoR uu> 



Figure 2. Coprocessor Registers and Operations 
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ALUC — Arithmetic Logic Unit Control 



$0044 



Bit 7 


6 


5 


4 


3 


2 


1 


BitO 


SIG 


DIV 


MAC 


DCC 


TRG 

































SIG — Signed Number Enable 

= AREG, BREG, and CREG contents are unsigned numbers 

1 = AREG, BREG, and CREG contents are signed nunnbers 
DIV — Division Enable 

MAC — Multiply with Accumulated Product Enable 
DCC — Division Compensation for Concatenated Quotient Enable 
TRG — Function Start Trigger Bit 
Always reads zero 

= No effect 

1 = Start ALU 

Bits [2:0] — Not implemented 
Always read zero 



SIG 


DIV 


MAC 


DCC 


FUNCTION 


START TRIGGERS 











X 


Unsigned MUL 


Write BREG or set TRG 


1 








X 


Signed MUL 


Write BREG or set TRG 








1 


X 


Unsigned MAC 


Write BREG or set TRG 


1 





1 


X 


Signed MAC 


Write BREG or set TRG 










X 


Unsigned IDIV 


Write AREG or set TRG 


1 










Signed IDIV 


Write AREG or set TRG 


1 







1 


Signed IDIV DCC 


Write AREG or set TRG 







1 


X 


Unsigned FDIV 


Set TRG 


1 




1 





Signed FDIV 


Set TRG 


1 




1 


1 


Signed FDIV DCC 


Set TRG 



ALUF — Arithmetic Logic Unit Status Flag Register $00 49 



RESET: 



Bit 7 


6 


5 


4 


3 


2 


1 


BitO 


NEG 


RZF 








OVF 


DZF 


ACF 



























NEG — Negative Result 

NEG is set if the result is a negative value. This is a read-only-bit. Writes to this bit do not affect the 
value. 

RZF — Remainder Equals Zero Flag 

RZF is set if the remainder is zero. 
Bits [5:3] — Not implemented 

Always read zero 
OVF — Overflow Flag 

OVF is set if overflow from MSB on CREG is detected. This bit is cleared automatically by a write to 

this register with bit 2 set. 
DZF — Divide by Zero Flag 

DZF is set if a divide by zero condition is detected. DZF is cleared automatically by a write to this 

register with bit 1 set. 
ACF — Arithmetic Completion Flag 

ACF is set by completion of the arithmetic operation. ACF is cleared automatically by a write to this 

register with bit set. 
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32-BIT SIGNED INTEGER NUMBER 



31 



16 



T 



CREG HIGH 



15 



CREG LOW 



'SIGN BIT 
16-BiT SIGNED INTEGER NUMBER 



INTEGER- 
CREG 

15 



-2147483648 
TO 

+2147483647 



INTEGER 



SIGN BIT 

AREG or BREG 



16-BiT FRACTION NUMBER AFTER FDIV 



-1 



-16 



FRACTION 



RADIX POINT 



-32768 
TO 

^ 32767 
RADIX POINT 



0.00000 

TO 
0.99998 



CREG LOW 
RADIX POINT 

SIGN BIT IS IN INTEGER PART OR NEG FLAG 



32-Brr SIGNED INTEGER AND FRACTION FOLLOWING AN FDIV 

15 -1 



INTEGER 



-16 



FRACTION 



CREG HIGH 

'SIGN BIT 

CREG 

LONG WORD SIGNED RESULT AFTER FDIV FOLLOWING AN IDIV 



k CREG LOW 
RADIX POINT 



-32768.99998 
TO 

+32767.99998 



31 



16,15 



CREG HIGH AFTER IDIV 



CREG LOW AFTER IDIV 



SIGN BIT 



INTEGER- 
CREG 



RADIX POINT 



15 



-1 



S CREG HIGH AFTER FDIV 



INTEGER 



SIGN BIT 



■16 



CREG LOW AFTER FDIV 



-FRACTION- 



y 



RADIX POINT 
CREG 



COPROCESSOR 

ncaronuAT 



Figure 3. ALU Data Register Format 
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Table 1. Numeric Ranges of ALU Registers 



Register 


Size 


Unsigned 


Signed 


AREG 


16 bits 


to 65535 


-32.768 to +32,767 


BREG 


16 bits 


to 65535 


-32,768 to +32,767 


GREG 


32 bits 


to 4,294,967,295 


-2,147,483,648 to +2,147,483,647 



Table 2. Signed Numbers 



Decimal 


16-Blt Hexadecimal 


32-Blt Hexadecimal 


+2,147,483,647 




$7l-l-h 1-hhH 








« 






+32,767 


$7Fi=T= 


$0000 7FFF 






« 


• 


• 


« 


+1 


$0001 


$0000 0001 





$0000 


$0000 0000 


-1 


$i-l-i-H 


$l-t-l-h l-hhi- 


-2 


$FFFE 


$1-1-1-F t-l-l-h 




• 










-32,768 


$8000 


$FFFF8000 














-2,147,483,647 




$8000 0000 
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Table 3. Fractions 

i 



n M A 1 1 

U6cimai 


1 o-Dii noxaaociniai 


+u.yyyyo 


Jprrrr 










+U.O 








+U. 1 




. n ncoc 


CI nnn 
Ipl UUU 


+U.UO 1 


$UoUU 


+U.U1 OO^O 








• 


• 


+0.0000153 


$0001 


-0.99998 


$0001 


• 


• 


• 


• 


-0.5 


$8000 


-0.25 


$cooo 


-0.125 


$E000 


-0.0625 


$F000 


-0.03125 


$F800 


-0.015625 


$FCOO 






• 




-0.0000153 


$FFFF 
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ASSEMBLY LANGUAGE IMPLEMENTATION 

The assembly language version of the P!D control routine consists of a C master program and an assembly 
subroutine (DOPID) that carries out all time-critical tasks (see Appendix B for a complete listing). The C 
master program is used for convenience — DOPID can be made to stand alone with minor changes in 
variable definition. 

The constant and variable number representation for the assembly version of the PID loop is a four-byte 
number consisting of a 16-bit integer, an implied decimal point, and a 16-bit fraction. This representation 
was chosen to provide relatively high performance while giving enough precision to support 
MC68HC11N4 8-, 12-, and 16-bit PWM resolutions. Many other formats could be used, each with a 
particular trade-off between precision and time. 

Although the sampling period constant and the constants of each term of the PID algorithm could be 
calculated during the assembly phase and set in the final code, these values are instead initialized as ratios 
of hexadecimal integers, then calculated in real time in the loop. This arrangement allows easy 
experimentation with these values without reassembling each time a value is changed. The initial format of 
these values (numerator and denominator) is a consequence of the four-byte numeric representation. 

Here are some examples of ALU operations performed during PID computation. 

To perform a signed integer divide followed by a signed fractional divide, the numerator is written to 
GREG, $C0 is written to ALUC, and the divisor is written to AREG. After the completion flag in ALUF is 
set ($49), $E8 is written to ALUC. Following integer division, the quotient is in CREG and the 
remainder is in BREG. Fractional division moves the content of CREG Low to CREG High, then places 
a 16-bit fraction in CREG Low. The final result is a 1 6-bit quotient in CREG High and a 16-bit fraction in 
CREG Low. There is an implicit decimal point between CREG High and CREG Low. More precision 
can be obtained by concatenating fractional divisions. 

To perform a signed multiply, $80 is written to ALUC and multiplicands are written to AREG and BREG. 
When the operation is complete, a 32-bit result is in CREG. 

The actual range used for control is hexadecimal $0000.0000 to $OOFF.FFFF (decimal to 255.99998). 
While the error term can be positive or negative, PWM output and feedback voltage are always positive. A 
result greater than $FF is treated as an overflow, and a result less than $00 is treated as an underflow. This 
effects a saturated value of the correct sign as in the C version. Except for the expression of initial 
constants as ratios, formula 5 is not changed. In the derivative term the factor 

(KDNUM / KDDEN) / ((6 • (PERDTNUM / PERDTDEN)) 

is rearranged to 

({KDNUM / KDDEN) * PERDTDEN) / (6 • PERDTNUM). 

The DOPID routine is written as straight-line code. Only two subroutines and a limit-checking section are 
shared by the proportional, integral, and derivative terms. The subroutines MULLNG and ADLNG are 
used to multiply and add terms and factors expressed in the special four-byte format explained previously. 
Each of the P, I, and D terms use ADLNG to contribute to the new PWM duty cycle (NEWDTY), but, as in 
the C version of the PID routine, NEWDTY is not output until the beginning of the next period. Only the 
8-bit integer portion is. used, and the 1-bit round-off error this causes is not corrected — the effect is 
negligible in this 8-bit example. After all three terms are calculated, control is returned to the master C 
routine. The master routine updates the error and A to D pipelines, then enters the main wait loop. 

During program execution, all results and most intermediate values are kept in RAM, rather than on the 
stack. Controller state can easily be inspected by means of a single breakpoint and a dump of the 
appropriate variable address. Variable addresses are provided in the C startup code for the assembly 
routine — the addresses are only valid for this compilation and can change with code revision. 
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HARDWARE PLATFORM 

The Motorola M68HC11KMNPEVS Evaluation System can be used to run both versions of the PID 
routine. With an MC68HC11K4 inserted in the emulator module, only the floating point version will 
execute. With an MC68HC1 1 N4 inserted, both versions can be executed — the floating point version 
simply does not use the math coprocessor. 

Both versions of the PID routine utilize special test mode in the EVS system. This means that the 
M68HC1 1 processor vectors are mapped from $BFD6 to $BFFF instead of from $FFD6 to $FFFF. and can 
be placed in user RAM or in emulation RAM, making experimentation with varied processor configuration 
options easier. Refer to the M68HC11KMNPEVS Evaluation System User's Manual for more information. 

S-record formatted object code can be loaded and njn on the EVS using appropriate serial 
communications software. The default EVS Baud rate is 19200 Baud. 

A simple RC circuit is used to provide the feedback necessary for the software PID loop to operate. The 
connections to the EVS are shown in Figure 4. PHO is the processor PWM output and PEO is the cha nnel 
1 A/D input. Note that the A/D reference inputs must be connected to appropriate supplies and the IRQ 
line must also be tied high. A two-channel oscilloscope can be used to observe PWM output and 
controlled voltage. Both versions of the code write $FF to PORTA just before performing PID loop 
calculations and then write $00 to the port just after calculations are complete, allowing execution times to 
be observed with a scope. 



3.3 MQ 




4.7 Ml 
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Figure 4. Evaluation System Schematic 
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PERFORMANCE 



Since two very different approaches were taken to implement the PID loop algorithm, it is not surprising 
that the performance and code sizes of the two routines differ significantly. The C language version 
contains over 1500 bytes, much of which consists of floating point runtime support. Because it carries full 
floating-point precision and does not use math support hardware, the C version takes approximately 6 
milliseconds to complete the loop. The assembly version contains approximately 1000 bytes, and could 
be reduced to about 800 bytes if features added for clarity and experimentation were removed. Because 
it uses a tailored arithmetic format and gets a hardware assist from the math coprocessor, the assembly 
version completes the loop in approximately 700 microseconds. In both cases, performance could be 
improved by precomputing all the results with constant factors. 



EXPERIMENTS AND EXTENSIONS 

To develop a more intuitive understanding of PID loop function, try varying the term constants in the 
object code and observing the effect on controller performance. For the C version, it is best to change 
the values in the C source and recompile. For the assembly version, it is easy to recalculate and change 
denominators of the constants: only decimal-to-hex conversion is required. The PERDT constant must 
be changed when the RTl interrupt rate is changed, or the time base of the algorithm will be destroyed. 
Try adjusting the proportional and derivative constants to give good observable control and then start 
substituting smaller value resistors for Ri. Eventually, the substitution will cause an unstable 
underdamped system. 

Many extensions to the routines are simple yet interesting. The command voltage level can be read from 
one of the seven unused AJD channels to give real-time control points. The MC68HC1 1 N4 version could 
have analog output instead of PWM with the use of an 8-bit D/A channel. The N4 version could also use 
an infinite impulse response (IIR) filter implemented by means of the math coprocessor multiply-and- 
accumulate capability, rather than utilizing the noise-canceling effect of the derivative term's four point 
central difference. 



CONCLUSIONS 

With the 16.383 millisecond sampling rate chosen, the floating point C routine cannot service all four 
MC68HC1 1K4 PWM channels. It could, however, service one higher-rale channel and several less time- 
critical processes. The assembly math coprocessor routine can service all the MC68HC11N4 PWM 
channels (four 8-bit and two 12-bit) in 4.2 milliseconds, leaving 75% of execution time for other tasks. If 
the MC68HC11N4 D/A channels were also used, six independent PID controllers could be run in 5.6 
milliseconds — this routine would use less than a third of the allowable processing time and require only 
half of the twelve MC68HC1 1N4 A/D input channels. 

The two approaches to PID control outlined in this note encompass a wide range of useful and cost- 
effective applications. The simplicity of the coded C algorithm is very appealing. Since the C routine 
carries virtually no code-space overhead, it is very well-suited to an application where floating-point math is 
already required, and a sampling rate in the 20-millisecond range is acceptable. Because it uses a number 
format adapted to the application and to use of on-chip resources, the assembly routine generally yields 
higher, more cost-effective performance than the C routine. 

A final word of caution. There is no substitute for thorough mathematical analysis of the system to be 
controlled in the discrete time domain. References 2 and 3 contain detailed discussions of control 
systems and analytic techniques. 
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APPENDIX A 
C LANGUAGE PID ROUTINE 



A.1 Main C Routine 



#include <stdio.h> 
#include <io6811Ic4 .h> 
#include <iiit6811k .h> 
#include <math.h> 



zpage 


unsigned int 


TOFCOONT; 


zpage 


float 


CMNDVX; 


zpage 


float 


ADRCX; 


zpage 


float 


ADRCXMl; 


zpage 


float 


ADRCXM2; 


zpage 


float 


ADRCXM3 ; 


zpage 


float 


ERRX; 


zpage 


float 


ERRMIX; 


zpage 


float 


ERRM2X; 


zpage 


float 


ERRM3X; 


zpage 


float 


PERDT; 


zpage 


float 


NEWDTY; 


zpage 


float 


OLDDTY; 


zpage 


float 


KP; 


zpage 


float 


KD; 


zpage 


float 


KI; 



/* declare variables */ 



extern int DOIO (void) 



/* prototype for assembly 
routine */ 



void mainO 

{ 

CMNDVX = 1.5; 
PERDT = 0.016383; 
KP = 0.18; 
KI = 6.0; 
KD " 0.009; 
OLDDTY =■ 1.9; 
PORTA - 0x00; 
DDRA = OxFF; 
PACTL =■ 0x03; 
TMSK2 =■ 0x40; 
OPTION =■ 0x90; 
PWPERl =■ OxFF; 
PWDTYl =■ OxFF; 
PWPOL = 0x01; 
DDRH =■ 0x00; 
PWEN = 0x01; 
TFLG2 = 0x40; 
anable_interrupt () ; 
wait for interrupt () 



/* main program */ 



/* RTI and therefore PID loop period = 16.383 ms */ 
/* kp =» .12, ki - 6.0, led =- .006, for 1 M ohm drive */ 



/* start out with pwm set fairly high */ 

/* this will be used for a scope trigger 

/* set PORTA as output */ 

/* set RTI to 16.383 ms (E - 4 MHz) */ 

/* enable RTI interrupts */ 

/* enable A/D charge pump */ 

/* set up PWM channel 1 at 15.625 k&z */ 

/* with positive polarity */ 



/* wait here for RTI to cause loop execution */ 



for (;;) ( 
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interrupt void IRQ_interrupt (void) /* should initialize all interrupts... */ 



PORTA = OxFF; 
PORTA = 0x00; 



interrupt void TO_interrupt ( void) 



TOFCOaNT++ ; 



interrupt void RTI_interrupt (void) 



/*PID LOOP/PWM routine */ 



PORTA =■ OxFF; 
DOIOO ; 



/* scope strobe */ 

/* read A to D and output the duty 
cycle calculated last period */ 



ADCTL - 0x10; /* begin new conversion cycle */ 

ERRX =• (CMNDVX - ADRCX) ; /* calculate current error */ 

/* The statement below is the entire floating point PID loop •/ 

NEWDTY " KP*(ERRX) + KI'PERDT* (CMNDVX - (ADRCX + ADRCXMl) /2) 

+ (KD/ (6*PERDT) ) * ( (ERBX - ERRM3X) + 3*(ERRM1X - ERRM2X) ) 
+ OLDDTY; 



if (NEWDTY > 1.99609) 
NEWDTY - 1.99609; 
else if (NEWDTY < 1.0) 
NEWDTY =■ 1.0; 



TFLG2 - 0x4 0; 
ADRCXMl - ADRCX 
ERRM3X = ERRM2X 
ERRM2X =■ ERRMIX 
ERRMIX = ERRX; 
OLDDTY - NEWDTY; 



PORTA = 0x00; 



/* test for result being in usable */ 
/* limits and set PWM duty cycle if */ 
/* beyond saturation */ 



/* clear RTI flag */ 

/* update A/D result for next cycle */ 
/* update error pipeline •/ 



/• update old duty cycle for next 
calculation period */ 

/* scope strobe */ 
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A.2 DOlO Subroutine Assembler Listing 



1 

2 
3 
4 
5 
S 
7 

8 0000 

9 0000 
10 

11 0000 

12 0000 
13 

14 ooec 

15 0031 

16 0000 

17 0000 

18 0000 

19 0000 8e3F 

20 0002 5F 

21 0003 DDOO 

22 0005 9631 

23 0007 04 

24 0008 SASO 

25 OOOA DDOl 

26 OOOC 5F 

27 OOOD D703 

28 OOOF DCOl 

29 0011 05 

30 0012 976C 

31 0014 39 

32 0015 



* DOIO assenfciLy funccion * 

* This rouCine handles the camersion beCween ♦ 

* 8 bit rarister values and the C float variables * 

* ♦ 



tCDCI£ DOIO 

PUBLIC DOIO 

P68H11 

RSB3 ccce 



EWDTYl set 
flXKL set 

EXTEMJ 

DOIO: 

USA 
CLUB 

sro 

WfA 
LSRD 
OBAA 

sm 
ca?B 

LCD 

STAA 

KTS 

EM3 



S006C 
50031 

XSPCXiZPfCZ 

#53F 

SDICX 
SDRl 

tsso 

ADPCX+l 

flDICX+3 
NE30TY+1 

PWDEn 



SB3ISTER DXAXIONS 

EXTESNSL vmmE LOOVnCNS 



mmsLizE fddm: iccftxicN. 

CTT CHRNNEL 1 A/D RESdLX. 

sHiET TO nrar mantissa positicn. 

CR m IZSST SIQJIFICfiNT EXP BIT 
?ND STORE IT m FIOAT VMIISBLE. 
CLEAR I£AST SICSnnCfHT 
FICRT 3YIE. 

osr TVD ariEs cf Fiafli mjotissa. 

SHUT TO CORKBCr 5BGISTER ECSmCN. 
OOTPOT TO EWl DOTY HEEISIER. 
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APPENDIX B 
ASSEMBLY LANGUAGE PID ROUTINE 



B.1 Master C Routine 



/* This code just sets up variables and does some updates 
after the assembly PID loop is called. */ 

#include <stdio.h> 
♦include <io6811N4.h> 
#include <lnt6811N.h> 



zpage 


unsigned int 


TOFCOONT; 


zpacfe 


signed int 


CMNDVX; 


zpage 


signed int 


ADRCX; 




zpacfe 


signed int 


ADRCXMl ; 


zpa<^e 


signed int 


ERRX; 




zpacfe 


signed int 


ERRMIX 




zpage 




ERRM2X 




zpage 


signed int 


ERRM3X 




zpage 


signed int 


KPNDM; 




zpage 


signed int 


KPDEN; 




zpage 


signed int 


KINDM; 




zpage 


signed int 


SIDEN; 




zpage 


signed int 


KDNOM; 




zpage 


signed int 


KDDEN ; 




zpage 


signed int 


PERDTNDM; 


zpage 


signed int 


PERDTDEN; 


zpage 


signed int 


INT56; 




zpage 


signed int 


FC56; 




zpage 


signed int 


TEMPI; 




zpage 


signed int 


TEMP 2, • 




zpage 


signed int 


TEMP 3 ; 




zpage 


signed int 


TEMP 4; 




zpage 


long 


NEWDTY; 


zpage 


long 


OLDDTY; 


zpage 


long 


KPTRM; 




zpage 


long 


XDTRM; 




zpage 


long 


KITRM; 




zpage 


long 


LTEMPl 




zpage 


long 


LTEMP2 




zpage 


long 


LTEMP3 




zpage 


long 


LTEMP4 




zpage 


long 


LTEMP5 




zpage 


long 


LTEMP6 




zpage 


long 


LTEMP7 




zpage 


long 


LTEMP8 




zpage 


long 


LTEMP9 




zpage 


long 


LTEMPA 




zpage 


long 


"CINT5 6; 


zpage 


long 


INTFCS6; 



/* declare variables */ 



extern mt 



OOP ID (void) ; 



/' prototype for assembly 
routine »/ 



AN1215/D 



MOTOROUV 
17 



void main ( ) 


/* 


main program */ 






{ 

CMNDVX = 0x0080; 










PERDTNUM = OxOOfl4; 










PERDTDEN = 0x2710; 


/• 


PERIOD = 164/10000 decimal 


*/ 




KPNUM = OxOOOC; 










KPDEN = 0x00 64; 


/• 


Icp -= .12, lei =» 6.0, led - . 


006, 


for 


KINUM = 0x000 6; 










KIDEN = 0x0001; 










KDNUM = 0x000 6; 










KDDEN = 0X03E8; 










OLDDTY =Ox00FFO000; 










PORTA = 0x00; 










DDRA = OxFF; 


/• 


set PORTA as output */ 






PACTL = 0x03; 


/* 


set RTI to 16.383 ms (E = 


4MHz) 


*/ 


TMSK2 = 0x4 0; 


/* 


enable RTI Interrupts */ 






OPTION = 0x90; 


/* 


enable A/D charge pump */ 






PWPERl = OxFF; 


/* 


set up PWM channel 1 at 15 


.625 


Icflz 


PWDTYl =- OxFF; 


/* 


with positive polarity */ 






PWPOL => 0x01; 










DDRH =- 0x00; 










PWEN = 0x01; 










TFLG2 = 0x4 0; 











enabla_i:itarrupt ( ) ; /* wait for RTI to execute assembly PID routine */ 

wait_f or_interrupt () ; 

for (;;) { 
; } 

) 



interrupt void IRQ_interrupt (void) /* Just some traps for unexpected */ 

{ /* interrupts ♦/ 

PORTA = OxFF; 
PORTA = 0x00; 

> 

interrupt void TO_interrupt (void) 

( 

TOFCOUNT++ ; 

} 



interrupt void RTI_interrupt (void) /* PWM routine */ 

{ 

PORTA =- OxFF; /* scope strobe */ 

DOPIDO; /*D0 THE PID LOOP USING THE MATH 

COPROCESSOR •/ 



/* NEWDTY = KP*(ERRX) + KI *°ERDT* (CMNDVX - (ADRCX + ADRCXMl)/2) 

+ (KD/ (6*PERDT) ) * ( (ERRX - ERRM3X) + 3* (ERRMIX - ERRM2X) ) 
+ OLDDTY; -/ 



TFLG2 =- 0x4 0; 
ADRCXMl = ADRCX 
SRRM3X = 3RRM2X 
£RRM2X = ERRMIX 
IRRMIX = ERRX; 
PORTA = 0x00; 



/• clear RTI flag */ 

/• update A/Q result for next cycle ♦/ 
/* update error pipeline ♦/ 



scope stroDe 
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B.2 DOPID Assembly Listing 



1 

2 
3 
4 
5 
6 
7 
8 
9 
10 
11 
12 
13 



******** 



******************** 



DOPID assembly function * 

These routines calculate the new PWM duty cycle * 

using the MC68HC11N4 math coprocessor. The * 

code can be run on an M68HC11EVS with an * 

M68HC11K4 emulator and MC68HC11N4 processor. * 

The EVS monitor should be 1.1 or later. The EVS * 

and vectors were set to SPECIAL TEST MODE to aid debug. * 

This code is called by a C routine but could be converted * 

to an all assembly environment by defining the variables * 

in assembly instead of as externals. * 
*************************************************************** 



14 


0000 


MODDLE 


DOPID 




15 


0000 


POBLIC 


DOPID 




16 










17 


0000 


P68H11 






18 


0000 


RSEG 


CODE 




19 










20 


006C 


PWDTYl set 


S006C 




21 


0030 


ADCTL set 


$0030 




22 


0031 


ADRl set 


S0031 




23 


0040 


CREGH set 


$0040 




24 


0041 


CREGMH sec 


$0041 




25 


0042 


CREGML sec 


$0042 




26 


0043 


CREGL sec 


S0043 




27 


0044 


ALOC set 


$0044 




28 


0045 


AREGH set 


50045 




29 


0046 


AREGL set 


$0046 




30 


0047 


3REGH set 


$0047 




31 


0048 


3REGI, sec 


$0048 




32 


0049 


ALOF set 


$0049 




33 










34 










35 










36 










37 


0000 


EXTERN 


ADRCXiZPAGE 


$0084 


38 


0000 


EXTERN 


.\DRCXM1:ZPAGE 


$0086 


39 


0000 


EXTERN 


CMNDVXrZPAGE 


$0082 


40 


0000 


EXTERN 


ERRX:ZPAGE 


S0088 


41 


0000 


EXTERN 


ERRM1X:ZPAGE 


SOOBA 


42 


0000 


EXTERN 


ERRM2X:ZPAGE 


$008C 


43 


0000 


EXTERN 


ERRM3X:ZPAGE 


$008E 


44 


0000 


EXTERN 


KPNOM:ZPAGE 


S0090 


45 


0000 


EXTERN 


:<PDEN:ZPAGE 


$0092 


46 


0000 


EXTERN 


KINOM:ZPAGE 


$0094 


47 


0000 


EXTERN 


KIDEN:ZPAGE 


$0096 


48 


0000 


EXTERN 


XDN0M:ZPAGE 


$0098 


49 


0000 


EXTERN 


KDDEN:ZPAGE 


$009A 


50 


0000 


EXTERN 


?ERDTNDM:ZPAGE 


$009C 


51 


0000 


EXTERN 


PERDTDEN:ZPAGE 


$009E 


52 


0000 


EXTERN 


INT5 6:ZP.AGE 


$00A0 


S3 


0000 


EXTERN 


EC5 6:ZPAGE 


S00A2 


54 


0000 


EXTERN 


TEMPI : ZPAGE 


$00A4 


55 


0000 


EXTERN 


TEMP 2 : ZPAGE 


300A6 


56 


0000 


EXTERN 


TEMP3 : ZPAGE 


$00A8 


57 


0000 


EXTERN 


rEMP4: ZPAGE 


SOOAA 


58 


0000 


EXTERN 


SPTRM: ZPAGE 


300B4 


59 


0000 


EXTERN 


KITRM: ZPAGE 


SOOBC 


SO 


0000 


EXTERN 


KDTRM: ZPAGE 


S00B8 


51 


000 


EXTERN 


LTEMPl : ZPAGE 


300C0 


52 


0000 


iXTERN 


LTEMP2 : ZPAGE 


S00C4 


S3 


0000 


EXTERN 


LTEMP3: ZPAGE 


S00C3 


54 


0000 


EXTERN 


LrEMP4 : ZPAGE 


300CC 


5 5 


0000 


EXTERN 


LTEMP5 :ZPAGE 


SCODO 


56 


0000 


EXTERN 


LTEMP6: ZPAGE 


300D4 



EXTERNAL VARIABLES 
SIGNED INTS 



LONGS 
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C 1 
/ 








FyTFl^N 


T,TFMP7 'ZPAGE 


$00D8 


bo 








Ci A 1 £ii\Ll 




$OODC 


C Q 


n n n n 
u u u u 








T.TFMP <3 • 7PAf^F 

La X C^CIC y , i^C k» vJ 1.1 


$00E0 


1 C\ 


0000 






^ /\ X ^ r\ 


LTEMPA • ZPAGE 


S00E4 


1 1 
/ 1 


u u u u 






EXTERN 




$00E8 


72 


0000 






EXTERN 


INTFC5 6;2PAGE 


$OOEC 


73 


0000 






EXTERN 


OLDDTY: ZPAGE 


$00B0 


1 ^ 


u u 






EXTERN 




$OOAC 


-7 c 
/ J 


u VJ u u 




DOPID: 








7 6 
7 7 






*»»«**** ODTPOT 


T.A^T PTR TOD PTJ"SnT.T AND 


no KP TERM ******** 


7 8 


0000 


9601 




LDAA 


LiCinU X X ~ X 


nriTPnT PPFVinn^ pat r 


7 9 


0002 


97 6C 




STAA 


PWDTYl 




80 


0004 


4F 




CLRA 






81 


0005 


D631 




LDAB 


ADRl 


GET CHANNFT. 1 A/n PF*?nTT 


82 


0007 


DDOO 




STD 


ADRCX 


DO KP TERM 


83 


0009 


C610 




LDAB 


#S10 


FIRST START NEW A/D 


84 


OOOB 


D730 




STAB 


ADCTL 


No w Lf V Ci VVO X w Ll 


85 


OOOD 


DCOO 




LDD 


CMNDVX 




o o 


OOOF 


9300 




SDBD 




FORM FRRHR TFRM 




0011 


DDOO 




STD 


TTRP V 




8 3 


0013 


2B06 




3MI 


MFT Af^l 
Li r Ltn^ X 




8 9 


0015 


8600 




LDAA 


#$00 




90 


0017 


9700 




STAA 


TEMP 3 




91 


0019 


2004 




BRA 


NFLGG2 




92 


OOIB 


8 6FF 


NFLAGl 


LDAA 


#$FF 


NEG 


93 


OOID 


9700 




STAA 


TEMP 3 




94 


OOIF 


8680 


NFLGG2 


LDAA 


#$80 


SET ALU FOR SMUL 


95 


002 1 


9744 




STAA 


ALOC 




96 


0023 


DCOO 




LDD 


ERRX 




97 


0025 


DD45 




STD 


AREGH 




98 


0027 


8601 




LDAA 


#$01 


PT.PAR APF 


99 


002 9 


9749 




STAA 


ALDF 




100 


002B 


DCOO 




LDD 


t\r LI vj n 




101 


002D 


DD47 




STD 




TRTrtPFR "^MfTT 


102 


002F 




WPMDLl 


BRCLR 






103 


0033 


3 6C0 




LDAA 


ISDO 


^FT AT,n ^OR ^ TflT V 


104 


0035 


DD44 




STD 


ALOC 




105 


0037 


8601 




LDAA 


f SOI 


CLEAR ACF 

Va# ^L^r\L\ rTXitf k 


106 


0039 


9749 




STAA 


ALOF 




107 


003B 


DCOO 




LDD 


KPDEN 




108 


003D 


DD45 




STD 


AREGH 


TR TPPFR rn TV 


109 


003F 


134901FC 


WPDIVl 


BRCLR 


ALDF #SQ1 HPDIVT 


WATT FOR APT 


110 


0043 


8601 




LDAA 


#$01 


PT.FAR APF 


111 


0045 


9749 




STAA 


ALDF 




112 


0047 


8 6E8 




LDAA 


#$E8 


TRT'^.'^FR *^FnT\7 
X£\x^u£.f\ or uxv 


113 


004 9 


DD44 




STD 


ALUC 




114 


004B 


1 14901 FC 


WPFDVl 


BRCLR 






115 


004F 


DC40 




LDD 




PFT TMT PART OF RFi^rTT T 


116 


0051 


DDOO 




STD 


KPTRM 




117 


0053 


DDOO 




STD 


LTEMPl 




113 


0055 


DC42 




LDD 


CREGML 


o xi X a r\n V» X X W Ll 


119 


0057 


DD02 




STD 


KPTRM+2 




120 


0059 


DD02 




STD 


LTEMPl +2 




12 1 


005B 


3003 61 




JSR 




vpw ann Tn pt nriTv 


122 


005E 


aDQ07F 




JSR 


OOKIT 


r\n T ""TTQM inn to pt nnTv 


12 3 


00 61 


3D014F 




JSR 


OOKDT 


nn n ttrm ann fp pt nnTv 


124 


0064 


DCOO 




LDD 


NEWDTY 




125 


0066 


2B0F 




3MI 


JAM2P 




12 6 


0068 


X O J w w £ - 




CPD 


*SOOFF 




127 


006C 


2310 




BMI 


KXDONE 




123 


006E 


CCOOFF 




LDD 


#$OOFF 


JAM FF 


12 9 


0071 


DDOO 




STD 


NEWDTY 




130 


0073 


DDOO 




STD 


OLDDTY 




131 


0075 


2007 




3RA 


u W vi ^ 




132 


0077 


CCOOOO 


JAMZ? 


LDD 


+S0000 


JAM OC 


133 


007A 


DDOO 




STD 


MEWDTY 


SATURATED ICW 


13 4 


007C 


DDOO 




STD 


CLDDTY 




135 


007E 


39 


KXDGNE 


RTS 
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136 














137 






» ROOTINE TO DO 


INTEGRAL TERM * 




138 














139 


007F 


DCOO 


DOKIT 


LDD 


ADRCX 


GET CURRENT CONVERSION 


140 


0081 


D300 




ADDD 


ADRCXMl 


FORM (ADRCX + ADRCXMl) /2 


141 


0083 


04 




LSRD 






142 


0084 


DDOO 




STD 


LTEMP2 




143 


0086 


2507 




BCS 


JMHAFI 




144 


0088 


CCOOOO 




LDD 


fSOOOO 




145 


008B 


DD02 




STD 


LTEMi'2+2 


FRACTIONAL PART OF FINAL ERROR 


146 


008D 


2 005 




BRA 


INTKIE 


TERM WILL ALWAYS BE or 0.5 


147 


008F 


CC8000 


JMHAFI 


LDD 


#S8000 




148 


0092 


DD02 




STD 


LTEMP2+2 




149 


0094 


DCOO 


INTKIE 


LDD 


CMNDVX 




150 


0096 


9300 




SOBD 


LTEMP2 




151 


0098 


1302800B 




BRCLR 


LTEMI'2+2, #S 80, NOFCN 




152 


009C 


DDOO 




STD 


LTEMi'2 




153 


009E 


1A830000 




CPD 


»S0000 




154 


00A2 


2F0B 




BLE 


NGFLG3 




155 


00A4 


830001 




SDBD 


#S0001 




156 


00A7 


DDOO 


NOFCN 


STD 


LTEMP2 


CMNDVX - {(ADRCX + ADRCXMl) /2) 


157 


00A9 


2B04 




BMI 


NGFLG3 


SET UP SIGN FLAG IN TEMP3 


158 


OOAB 


8600 




LDAA 


#S00 




159 


OOAD 


2002 




BRA 


NGFLG2 




160 


OOAF 


86FF 


HGFLG3 


LDAA 


#SFF 




161 


OOBl 


9700 


NGFLG2 


STAA 


TEMP 3 




162 


O0B3 


86C0 




LDAA 


#SD0 


SET ALU FOR SIDIV TO FORM 


163 


00B5 


DD44 




STD 


ALOC 


KINUM/KIDEN 


164 


00B7 


8601 




LDAA 


#S01 


CLEAR ACF 


165 


00B9 


9749 




STAA 


ALOF 




166 


OOBB 


CCOOOO 




LDD 


#SOO00 


SET UP KI NUMERATOR 


167 


OOBE 


DD40 




STD 


CREGH 




168 


OOCO 


DCOO 




LDD 


XINOM 




169 


00C2 


DD42 




STD 


CREGML 




170 


00C4 


DCOO 




LDD 


XIDEN 




171 


00C6 


DD45 




STD 


AREGH 


TRIGGER SIDIV 


172 


00C8 


134901FC 


MIDIVl 


BRCLR 


ALOF, #S01, HIDIVl 


WAIT FOR ACF 


173 


OOCC 


8601 




LDAA 


#S01 


CLEAR ACF 


174 


OOCE 


9749 




STAA 


ALOF 




175 


OODO 


86E8 




LDAA 


#SE8 


TRIGGER 3FDIV 


176 


00D2 


DD4 4 




STD 


ALOC 




177 


00D4 


134901FC 


WIFDVl 


BRCLR 


ALOF, #501, WIFDVl 


WAIT FOR ACF 


178 


00D8 


DC40 




LDD 


CREGH 




179 


OODA 


DDOO 




STD 


LTEMP3 




180 


OODC 


DC42 




LDD 


CREGML 




181 


OODE 


DD02 




STD 


LTEMP3+2 




182 


OOEO 


86C0 




LDAA 


#SDO 


SET ALU FOR SIDIV TO FORM 


183 


00E2 


DD44 




STD 


ALOC 


PERDTNUM/PERDTDEN 


184 


0OE4 


8601 




LDAA 


#S01 


CLEAR ACF 


185 


00E6 


9749 




STAA 


ALUF 




186 


00E8 


CCOOOO 




LDD 


#50000 


SET DP PERDTNDM 


187 


OOEB 


DD40 




STD 


CREGH 




188 


OOED 


DCOO 




LDD 


PERDTNDM 




189 


OOEF 


DD42 




STD 


CREGML 




190 


OOFl 


DCOO 




LDD 


PERDTDEN 




191 


0OF3 


DD4S 




STD 


AREGH 


TRIGGER SIDIV 


192 


OOFS 


134901FC 


WIDIV2 


BRCLR 


ALUF, #501, HIDIV2 


WAIT rOR ACF 


193 


0OF9 


8601 




LDAA 


#501 


CLEAR ACF 


194 


OOFB 


9749 




STAA 


ALUF 




195 


OOFD 


86E8 




LDAA 


#5E8 


TRIGGER SFDIV 


196 


OOFF 


DD44 




STD 


ALUC 




197 


0101 


134901FC 


WIFDV2 


BRCLR 


ALUF, #501,WIFDV2 


WAIT rOR ACF 


198 


0105 


DC40 




LDD 


CREGH 




199 


0107 


DDOO 




STD 


LTEMP4 




200 


0109 


DC42 




LDD 


CREGML 




201 


OlOB 


DD02 




STD 


LTEMP4^2 




202 


OlOD 


DCOO 




LDD 


LTEMP3 


NOW -CRM LTEMP2*LTEMP3*LTEMP4 


203 


OlOF 


DDOO 




STD 


LTEMP5 




204 


0111 


DC02 




LDD 


LTEMP3f2 





205 


0113 


DD02 




STD 


LTEMP5+2 




206 


0115 


DCOO 




LDD 


LrEMP4 




207 


0117 


DDOO 




STD 


LTEMP 6 




208 


0119 


DC02 




LDD 


LTEMP4 




209 


0113 


DD02 




STD 


LTEMP 6 + 2 




210 


OllD 


9600 




LDAA 


TEMP 3 


SAVt* biuN t LACa 


211 


OllF 


9700 




STAA 


TEMP 4 


ANU liLcicJ A^ A t IiACa 


212 


0121 


8 600 




LDAA 


#300 


c <Jr\ LiiCicrir' o Odxrika irvj^ J. l x vjl 


213 


0123 


9700 




STAA 


TEMP 3 




214 


0125 


BD023A 




JSR 


nULLNG 


no T TPMD T * T TPMD ^ /BirOnT*IfT^ 
UW Li X SLClC J Li IJUlir t \iziLt\U 1 1\X J 


215 


0128 


DCOO 




LDD 


LibMr / 


WOtJ DFIT PP^nT T TTJ T TPMD^ 
Di\Jn c KJ ± r\CiOULil XCl LixlLcUfD 


216 


012A 


DDOO 




STD 


LlEHJr 3 




217 


012C 


DC02 




LDD 


LTEMP 7 +2 




218 


012E 


DD02 




STD 


LiEMPa+<: 




219 


0130 


9600 




LDAA 


it*MP 1 


I^Xi X £\ X V Ej OXOiN £ l>Au 


220 


0132 


9700 




STAA 






221 


0134 


DCOO 




Luu 


T Tf MB T 
Lii tiHPZ 




222 


13 6 


DDOO 




STD 


T TCM'n cz 
LLt^nr b 


PPPOB POB KT TPPM 
£*C\.t\\JI\ C \JI\ t\X L£«xvn 


223 


138 


DC02 




LDD 


LibMP<; +<; 




224 


013A 


DD02 




STD 


LTEMP 5+2 




225 


013C 


BD023A 




JSR 


MOLLNG 




226 


013F 


DCOO 




LDD 


LTEMP 7 




227 


014 1 


DDOO 




STD 


LTEMP 1 




228 


0143 


DDOO 




STD 


KITRM 




22 9 


014 5 


DC02 




LDD 


T TT'HJO T ^ T 

LiJiMlr / +<; 




230 


014 7 


DD02 




STD 


LTEMP 1+2 




231 


014 9 


DD02 




STD 


aITRM+2 


AUU ft-l iEKM IN J.W Nt*WU i I 


232 


014B 


BD03 61 




JSR 


AOLNG 




233 


014E 


39 




RTS 




RETURN 


234 














235 






********** 


ROUTINE TO DO KD TERM 


Iriritititititititit 


236 














237 


014F 


DCOO 


DOKDT 


LDD 


SRRX 


FORM (ERRX " iRRMoX) 


238 


0151 


9300 




SOBD 


c^RRMja 




239 


0153 


DDOO 




STD 


it*MP i 




24 


0155 


DCOO 




LDD 


CO OUT V 




241 


0157 


9300 




SOBD 


iRRMzX 




242 


0159 


DD45 




STD 


AREGH 


r OKM (bRRMiX — z.i<RM<:X) 


243 


015B 


8 680 




LDAA 


T^380 




24 4 


015D 


97 4 4 




STAA 


ALUC 




245 


15F 


8 601 




LDAA 


#301 




24 6 


0161 


97 4 9 




STAA 


ALUF 




24 7 


0163 


CC0003 




LDD 


ff 5UUU J 




24 8 


0166 


DD47 




STD 


□REGH 




24 9 


0168 


134 901t C 


WDMOLO 


BRCLR 


ALUF/ ff^Ul, WUMUbU 


WAl i £ OR ACt 


25 


1 6C 


DC42 




LDD 


Q^RtiQanL 




251 


016E 


D300 




ADDD 






252 


0170 


DDOO 




STD 


T TTUn A 

LiEMr A 




253 


0172 


2B02 




BMI 


N(j£ bGoU 


<ZVT no CT^M PT TXT TPMOT 


254 


017 4 


2 00 6 




BRA 


f OoGN 




255 


017 6 


8 6FF 


NGFLGSO 


LDAA 


#3FF 




25 6 


017 8 


97 00 




STAA 


iE*MP J 




257 


17A 


2004 




BRA 






258 


17C 


3 600 


POSGN 


LDAA 


i < n n 

f -5 U U 




25 9 


17E 


y / uu 




STAA 






2 60 


0180 




KDFLGD 


LDD 


i C n 




251 


0183 


DD02 




STD 


LTiMPA+2 


r\MMP 


262 


0135 


3 600 




LDAA 


U U 




2 63 


0187 


97 4 4 




STAA 


ALOC 




2 64 


018 9 


a oUl 




LDAA 


U J. 




2 65 


013B 


97 4 9 




STAA 


ALiUr 




2 6 6 


013D 


CCOO 6 




LDD 


i c n ^ 
f 5UUU b 




2 67 


0190 


DD45 




STD 


AREGH 




2 68 


0192 


DCOO 




LDD 


n C Ti rXTXTTTH* 

rLRUTNUM 




2 69 


0194 


0D4 7 




STD 


3REGH 




270 


0196 


134901FC 


WDMULl 


BRCLR 


ALOF, #S01,WDMCL1 


WAIT FOR ACr 


271 


019A 


DC42 




LDD 


CREGML 




272 


019C 


DDOO 




STD 


TEMP 2 




273 


019E 


36C0 


NOFCND 


LDAA 


*SDO 


SET ALU FOR SID IV TO TCRM 



274 


OlAO 


DD44 




STD 


ALtJC 


KDNDM/KDDEN 


275 


01A2 


3601 




LDAA 


#SQ1 


CLEAR ACF 


276 


01A4 


9749 




STAA 


ALUF 




277 


01A6 


CCOOOO 




LDD 


#SO0OO 


SET OP KD NDMERATOR 


273 


01A9 


DD40 




STD 


CREGH 




279 


OlAB 


DCOO 




LDD 


BCDNOM 




280 


OlAD 


DD42 




STD 


CREGML 




281 


OlAF 


DCOO 




LDD 


KDDEN 




282 


OlBl 


DD45 




STD 


AREGH 


TRIGGER SIDIV 


283 


01B3 


134901FC 


WDDIVl 


BRCLR 


ALOF, #S01, WDDIVl 


WAIT FOR ACF 


284 


01B7 


8601 




LDAA 


#S01 


CLEAR ACF 


285 


01B9 


9749 




STAA 


ALOF 




28 6 


OIBB 


8 6E8 




LDAA 


#SE8 


TRIGGER SFDIV 


287 


OIBD 


DD44 




STD 


ALUC 




238 


OIBF 


134901FC 


WDFDVl 


BRCLR 


ALOF, fSOl, WDFDVl 


WAIT FOR ACF 


289 


01C3 


DC40 




LDD 


CREGH 




290 


01C5 


DDOO 




STD 


LTEMP8 




291 


01C7 


DC42 




LDD 


CREGML 




292 


01C9 


DD02 




STD 


LTEMP8+2 




293 


OICB 


8 6C0 




LDAA 


#SDO 


SET ALD FOR SIDIV TO FORM 


294 


OICD 


DD44 




STD 


ALDC 


PERDTDEN/ (PERDTN0M*6) 


295 


OICF 


8601 




LDAA 


#S01 


CLEAR ACF 


296 


OlDl 


9749 




STAA 


ALUF 




297 


01D3 


CCOOOO 




LDD 


#50000 


SET DP PERDTNDM 


298 


01D6 


DD40 




STD 


CREGH 




299 


01D8 


DCOO 




LDD 


PERDTDEN 




300 


OlDA 


DD42 




STD 


CREGML 




301 


OlDC 


DCOO 




LDD 


TEMP 2 




302 


OlDE 


DD45 




STD 


AREGH 


TRIGGER SIDIV 


303 


OlEO 


134901FC 


WDD IV2 


BRCLR 


ALOF, #301, WDDIV2 


WAIT FOR ACF 


304 


01E4 


8601 




LDAA 


#S01 


CLEAR ACF 


305 


01E6 


9749 




STAA 


ALOF 




306 


01E8 


86E3 




LDAA 


#SE8 


TRIGGER SFDIV 


307 


OlEA 


DD44 




STD 


ALDC 




308 


OISC 


134901FC 


WDFDV2 


BRCLR 


ALOF, #S01, WDFDV2 


WAIT FOR ACF 


309 


OlFO 


DC40 




LDD 


CREGH 




310 


01F2 


DDOO 




STD 


LTEMP 9 




311 


01F4 


DC42 




LDD 


CREGML 




312 


01F6 


DD02 




STD 


LTEMP 9+2 




313 


01F8 


DCOO 




LDD 


LTEMP 8 


NOW FORM LTEMPA*LTEMP8*LTEMP9 


314 


OlFA 


□ DOO 




STD 


LTEMP S 




315 


OlFC 


DC02 




LDD 


LTEMP 8+2 




316 


OlFE 


DD02 




STD 


LTEMP 5+2 




317 


0200 


DCOO 




LDD 


LTEMP 9 




318 


0202 


DDOO 




STD 


LTEMP 6 




319 


0204 


□C02 




LDD 


LTEMP 9+2 




320 


0206 


DD02 




STD 


LTEMP 6+2 




321 


0208 


9600 




LDAA 


TEMP 3 


SAVE SIGN FLAG 


322 


020A 


9700 




STAA 


TEMP 4 


AND USE TEMP 3 AS A FIAG 


323 


020C 


3600 




LDAA 


#500 


FOR LTEMP6 BEING POSITIVE 


324 


020E 


9700 




STAA 


TEMP 3 




325 


0210 


3D023A 




JSR 


MDLLNG 


DO LTEMP 8* LTEMP 9 


32 6 


0213 


DCOO 




LDD 


LTEMP 7 


NOW POT RESOLT IN LTEMP5 


327 


0215 


DDOO 




STD 


LTEMP 5 




328 


0217 


DC02 




LDD 


LTEMP 7 +2 




329 


0219 


DD02 




STD 


LTEMP 5 +2 




J30 


021B 


960O 




LDAA 


TEMP 4 


RETRIEVE SIGNED ERROR 


331 


021D 


9700 




STAA 


TEMP 3 




332 


021F 


DCOO 




LDD 


LTEMPA 




333 


0221 


DDOO 




STD 


LTEMP 6 


ERROR FOR KD TERM 


334 


0223 


DC02 




LDD 


LTEMPA+2 




335 


022S 


DD02 




STD 


LTEMP 6+2 




336 


022 7 


BD023A 




JSR 


MULLNG 


DO RESOLT* LTEMP A 


337 


322A 


DCOO 




LDD 


LTEMP 7 




338 


022C 


DDOO 




STD 


LTEMP 1 




339 


022E 


DDOO 




STD 


KDTRM 




340 


02 30 


DC02 




LQD 


LTEMP 7 +2 




341 


02 32 


DD02 




STD 


LTEMP 1+2 




342 


0234 


0D02 




STD 


XDTRM+2 





343 


0236 


BD0361 


JSR 


ADLNG 


ADD KD TERM INTO NEWDTY 


344 


0239 


39 


RTS 




KDTERM DONE 


345 












346 






• SOBROUTINE 


TO MULTIPLY LONGS ( INTEGER 


S FRACTION) * 


347 






* LTEMP5*LTEMP6=-LTEMP7 ONLY LTEMP6 CAN 


HAVE * 


348 






* A NEGATIVE 


TERM TO HANDLE. 


* 


349 












350 


023A 


8680 


MULLNG LDAA 


#S80 


SET ALO FOR SMUL 


351 


023C 


9744 


STAA 


ALUC 


AND MULTIPLY INT3 


352 


023E 


DCOO 


LDD 


LTEMP5 




353 


0240 


DD45 


STD 


AREGH 




354 


0242 


8601 


LDAA 


#S01 


CLEAR ACF 


355 


0244 


9749 


STAA 


ALDF 




356 


0246 


DCOO 


LOD 


LTEMP6 




357 


0248 


DD47 


STD 


BREGH 


TRIGGER SMUL 


358 


024A 


134901FC 


WMOLLl BRCLR 


ALOF, #S01,WMDLL1 


WAIT FOR ACF 


359 


024E 


DC42 


LDD 


CREGML 




360 


0250 


DDOO 


STD 


INT5 6 




361 


0252 


8601 


LDAA 


♦$01 


CLEAR ACF AND DO NEXT MULT 


362 


0254 


9749 


STAA 


ALDF 




363 


0256 


8680 


LDAA 


#$80 


TEST TEMP3 SIGN 


364 


0258 


9500 


BITA 


TEMP 3 


SEE IF ERR IS NEG 


365 


025A 


2312 


3MI 


NEGFRAC 


TERM IS NEGATIVE 


365 


025C 


DC02 


LDD 


LTEMP6+2 


GET FRAC NOT NEG 


367 


025E 


DD47 


STD 


BREGH 


TRIGGER SMUL 


368 


0260 


134901FC 


WMULL2 BRCLR 


ALDF, #S01, WMDLL2 


WAIT FOR ACF 


369 


0264 


DC40 


LDD 


CREGH 


SCALE AND STORE 


370 


0266 


DDOO 


STD 


INTFC5 6 




371 


0268 


DC42 


LDD 


CREGML 




372 


026A 


DD02 


STD 


INTFC5 6+2 




373 


026C 


2022 


BRA 


NXFRAC 




374 


026E 


CCOOOO 


NEGFRAC LDD 


♦$0000 


NEGATE FRAC 


375 


0271 


9302 


SUBD 


LTEMP6+2 




376 


0273 


DD47 


STD 


BREGH 


TRIGGER SMUL 


377 


0275 


134901FC 


WMULL3 BRCLR 


ALOF, #$01, WMDLL3 


WAIT FOR ACF 


378 


0279 


CCOOOO 


LDD. 


*$0000 


NEGATE RESULT 


379 


027C 


9340 


SUBD 


CREGH 


SCALE AND STORE 


380 


027E 


2B02 


BMI 


INTFIXl 




381 


0280 


2003 


BRA 


INTFIX2 




382 


0282 


C30001 


INTFIXl ADDD 


#$0001 




383 


0285 


DDOO 


INTFIX2 STD 


mTFC5 6 




384 


0287 


CCOOOO 


LDD 


#$0000 




385 


028A 


9342 


S03D 


CREGML 




386 


028C 


DD02 


STD 


I1ITFC56+2 




387 


028E 


3600 


LDAA 


#$00 




388 


0290 


DC02 


NXFRAC LDD 


LTEMP5+2 


GET FRAC AND MULTIPLY 


389 


0292 


DD45 


STD 


AREGH 


WITH POSSIBLE NEG INT 


390 


0294 


8601 


LDAA 


#$01 


CLEAR ACF 


391 


0296 


9749 


STAA 


ALUF 




392 


0298 


8600 


LDAA 


#$00 




393 


029A 


DCOO 


LDD 


LTEMP6 




394 


02 9C 


DD47 


STD 


BREGH 


TRIGGER SMUL 


395 


029E 


134901FC 


WMULL4 BRCLR 


ALUF, #501, 'rtMULL4 


WAIT FOR ACF 


396 


02A2 


8680 


LDAA 


#$80 




397 


a2A4 


9500 


BITA 


TEMP 3 




398 


02A6 


2A0F 


3P L 


DFXINT 




399 


02A8 


3680 


LDAA 


i c Q ri 


SEE IF SIGN OVERFLOW 


400 


02AA 


9545 




AREGH 


ON FRACTION 


401 


02 AC 


2B02 


BMI 


FXINT 




402 


02AE 


2007 


3RA 


DFXINT 




403 


0230 


CCOOOO 


FXINT LDD 


#S00C0 




404 


02B3 


9340 


SUBD 


CREGH 




405 


0235 


DD40 


STD 


CREGH 




406 


0237 


DC 4 


DFXINT LDD 


CREGH 


THIS SCALES FRAC 


407 


0239 


2B02 


3MI 


NFFIX 




408 


02B3 


2003 


3RA 






409 


C23D. 


C300C1 


NFFIX ADDD 


+SC0C1 




410 


02C0 


DDOO 


9FFIX STD 


;CINT5 6 




411 


02C2 


DC42 


LDD 


CREGML 





412 


02C4 


DD02 




STD 


FCINT5 6+2 




413 


02C6 


8601 




LDAA 


#S01 


NOW DO FRAC*FRAC 


414 


02C8 


9749 




STAA 


ALOF 


CLEAR ACF 


415 


02CA 


8600 




LDAA 


#S00 




416 


02CC 


9744 




STAA 


ALOC 


SET UNSIGNED MCJLT FOR 


417 


02CE 


86S0 




LDAA 


#S80 


TEST ERR SIGN 


418 


02D0 


9500 




BITA 


TEMP 3 


SEE IF ERR IS NEG 


419 


02D2 


2BaE 




EMI 


NFCFRAC 


TERM IS NEGATIVE 


420 


02D4 


DC02 




LDD 


LTEME 6+2 


GET FRAC NOT NEG 


421 


02D6 


DD47 




STD 


BREGH 


TRIGGER SMDL 


422 


0208 


134901FC 


WMDLL5 


BRCLR 


ALOF, #$01,WMOLLS 


WAIT FOR ACF 


42 3 


02DC 


DC 40 




LDD 


CREGH 


bCAIicl AnU 5 iUKc. 


424 


02DE 


DDOO 




STD 


FC56 




425 


02£0 


2012 




BRA 


SOMMDL 




426 


02E2 


/^/^ 

ccuoou 


NrCFElAC 


LDD 


#50000 


n£<GAi£ £ RAC 


427 


02E5 


9302 




SQBD 


LTEMP6+2 




428 


02E7 


DD47 




STD 


BREGH 


TRIGGER SMOIi 


429 


02E9 


134901FC 


WM0LL6 


BRCLR 


ALOF, #S01,WMOLL6 


WAIT FOR ACF 


430 


02ED 


ccoooo 




LDD 


#$0000 


NEGATE RESULT 


431 


02F0 


9340 




SOBD 


CREGH 


SCALE AND STORE 


432 


02F2 


DDOO 




STD 


FC56 




433 


02F4 


DCOO 


SDMMOL 


LDD 


INT56 


NOW SUMM ALL PRODUCTS 


434 


02F6 


D300 




ADDD 


FCINT5 6 


INTS ARE ALL SIGNED 


435 


02F8 


D300 




ADDD 


INTFCS6 


CAN JUST ADD OP 


43 6 


02FA 


DDOO 




STD 


LTEMP7 




437 


02FC 


8680 




LDAA 


#380 


TEST ERRX SIGN 


438 


02FE 


9500 




BITA 


TEMP 3 


SEE IF FRACS ARE NEG 


439 


0300 


2B22 




BMI 


SOMNFC 


FRACS ARE NEGAT IVE 


440 


0302 


DC02 




LDD 


FCINT5 6+2 


POSITIVE 


441 


0304 


D302 




ADDD 


INTFCS S+2 




442 


0306 


2502 




BCS 


FCCARl 




443 


0308 


2009 




BRA 


30MFC1 




444 


030A 


8F 


FCCARl 


XGDX 




SAVE SUM 


445 


030B 


CCOOOl 




LDD 


#50001 


ADD CARRY INTO INT 


44 6 


030E 


D300 




ADDD 


LTEMP7 




447 


0310 


DDOO 




STD 


LTEMP7 




448 


0312 


8F 




XGDX 




RETRIEVE SOM 


44 9 


0313 


D300 


SCJMFCl 


ADDD 


FC56 




450 


0315 


DD02 




STD 


LTEMP7+2 




451 


0317 


2502 




BCS 


rCCAR2 




452 


0319 


2045 




BRA 


SMFCDP 




453 


031B 


CCOOOl 


FCCAR2 


LDD 


#S0O01 


ADD CARRY INTO INT 


454 


031E 


D300 




ADDD 


LTEMP7 




455 


0320 


DDOO 




STD 


LTEMP7 




456 


0322 


203C 




BRA 


SMFCDP 




457 


0324 


CCOOOO 


SOMNFC 


LDD 


#50000 


COMPLEMENT NEG FRACS 


458 


0327 


9302 




SOBD 


FCINT56+2 




459 


0329 


DD02 




STD 


FCINT56+2 




460 


032B 


CCOOOO 




LDD 


#50000 




461 


032E 


9302 




SOBD 


INTFCS 6+2 




462 


0330 


DD02 




STD 


INTFC56+2 




463 


0332 


CCOOOO 




LDD 


#50000 




464 


0335 


9300 




SOBD 


FC5 6 




4 65 


0337 


DDOO 




STD 


rc5 6 




4 66 


0339 


DC02 




LDD 


CCINT36+2 


NEGATIVE 


467 


033B 


D302 




ADDD 


i.NTFC5 6+2 




468 


033D 


2502 




BCS 


FCCAR3 


REMEMBER SIGN BIT I ! 


469 


033F 


2009 




BRA 


3UMFC2 




470 


0341 


8F 


FCCAR3 


XGDX 




SAVE 3UM 


471 


0342 


CCFFFF 




LDD 


f 5r r c F 


ADD BORROW J.NTO iNT 


472 


0345 


D300 




ADDD 


UiEMr / 




473 


0347 


ODOO 




STD 






47 4 


n T 4 Q 


ar 












U JlA 


U J UU 






IT I- J o 




476 


034C 


DD02 




STD 


LTEMP7+2 




477 


034E 


2502 




BCS 


FCCAR4 




473 


0350 


2007 




3RA 


SMFCON 




479 


0352 


CCFFFF 


tCCAR4 


LDD 


#5rFFF 


ADD SORROW INTO INT 


480 


0355 


0300 




ADDD 


LTEMP 7 





481 


0357 


DDOO 


STD 


LTEMP7 




482 


u J o y 


rT" A n A A 


QMirr'nM t nn 




k^Li V L2\ X OnVvrv X U n ILu 


483 


U J oc 


Q T A 1 


Qnun 






48 4 


U 03t> 




O lU 






485 


0360 


39 








48 6 
48 7 












4 8 8 








ann TATnTf^iro awn 


PWAPTTflN TM TTVMPl TCi HT nnTY * 


48 9 












4 90 


A T C T 
U J O 1 


O 13 ou 


a n T ATr* t ns a 




Tr-CT rPRY ^TGi*! 


4 91 


A T C T 


Q Q AA 

y uu 


OJ. Irt 






4 


A T C 
u o oo 


y 


RMT 

On J. 






4 y J 


AT C7 
U J D / 


nr* A A 


LDD 


LTEMP 1 


GET INT PART 


4 94 


A T C Q 

u J D y 


m^^A 

JJ J <JU 


Annn 


riT nnTY 


Ann AND STQT^F TNT 


4 yo 


U-J DO 


nn AA 




MPWnT V 
LvCinU X I 




4 y D 






T.nn 


T TVMP1 +7 


£^FT FRAC PART 


A an 
^ y / 


IJ J o r 


m AO 


ADDD 


oT nnTYx7 

KJijUU L 1 


ADD AND STORE FRAC 


4 98 


A "3 "7 1 


nn AO 

UUU^ 


QTn 
O xu 






y1 Q Q 

*i y y 






BCS 


INCINT 




^ o n 


A 

U.J ' -J 


^ U XC< 


BRA 






jU J. 




AA A 1 


T'MPT'MT Tnn 
X nv. X 11 X xiLj u 


ftSAAAT 

T V W U X 


Ann CARRY F^OM FRAC 




03 7 A 


D300 


ADDD 
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